%eden

/* generically a robot can be represented as..
robot = [x,y,length,width,current speed,current direction, motor 1 on, motor 2 on, front bumper sensor
on, back bumper sensor on, lightsensor on, ... ];
Other new functionality could be added on to the end 
*/

robot1_x = 250; 
robot1_y = 250;
robot1_size = 10;
robot1_currentspeed = 0;
robot1_curdir = 0; /*i.e angle */
robot1_motor1on = FALSE;
robot1_motor2on = FALSE;
robot1_frontbumperon = FALSE;
robot1_backbumperon = FALSE;
robot1_lightsensoron = FALSE;
robot1_sensorsize is 4.0/10 * (robot1_size);

robot1 is [robot1_x,robot1_y,robot1_size, robot1_currentspeed, 
	     robot1_curdir, robot1_motor1on, robot1_motor2on, robot1_frontbumperon,
	     robot1_backbumperon, robot1_lightsensoron];

%donald

viewport world2

openshape robot1template

within robot1template {

#define the basic shape

 point robotcentre,robottopleft,robottopright,robotbottomleft, robotbottomright 
 line robottop,robotbottom,robotfront,robotback

 robotcentre = {robot1_x!,robot1_y!}
 robottopleft = robotcentre + { -robot1_size!,robot1_size! }
 robottopright = robotcentre + { robot1_size!, robot1_size! } 
 robotbottomleft = robotcentre + { -robot1_size!, -robot1_size! } 
 robotbottomright = robotcentre + { robot1_size!, -robot1_size! } 

 robottop = [robottopleft, robottopright]
 robotbottom = [robotbottomleft, robotbottomright]
 robotfront = [robottopleft, robotbottomleft]
 robotback = [robottopright, robotbottomright]


#now define the optional sensors 

 rectangle motor1, motor2, frontbumper, backbumper

 motor1 = rectangle(robottopleft+{4*robot1_size! div 5,0}, robottopleft+{6*robot1_size! div 5, robot1_sensorsize!} )
 motor2 = rectangle(robotbottomleft+{4*robot1_size! div 5,0}, robotbottomleft+{6*robot1_size! div 5, -robot1_sensorsize!} )

 frontbumper = rectangle(robotbottomleft+{0,4*robot1_size! div 5}, robotbottomleft+{-robot1_sensorsize!, 6*robot1_size! div 5} )
 backbumper = rectangle(robotbottomright+{0,4*robot1_size! div 5}, robotbottomright+{robot1_sensorsize!,6*robot1_size! div 5} )

 #?A_robot1template_motor1 is "color=blue,fill=solid";

}

viewport world 

shape therobot1
therobot1 = rot(robot1template,robot1template/robotcentre, robot1_curdir! div (2*pi))

%eden
A_robottop is "color=red";
A_robotbottom is "color=blue";
A_robotfront is "color=green";
A_robotback is "color=magenta";


%scout
integer rob1y,rob1height;
rob1y = 10; 
rob1height = 15;

integer robot1_motor1on;
integer robot1_motor2on;
integer robot1_frontbumperon;
integer robot1_backbumperon;
integer robot1_lightsensoron;


window rob1title = {
	type : TEXT
	frame : ([ {60+world_x, rob1y}, {160+world_x+rob1height*2, rob1y+rob1height} ])
	string : "Robot 1"
	alignment : CENTRE
	border : 1
};

window rob1motor1 = {
	type : TEXT
	frame : ([ {60+world_x, rob1y+rob1height}, {160+world_x, rob1y+rob1height*2} ])
	string : "Motor 1"
	alignment : LEFT
	border : 1
};
window rob1motor2 = {
	type : TEXT
	frame : ([ {60+world_x, rob1y+rob1height*2}, {160+world_x, rob1y+rob1height*3} ])
	string : "Motor 2"
	alignment : LEFT
	border : 1
};
window rob1frontbumpsensor = {
	type : TEXT
	frame : ([ {60+world_x, rob1y+rob1height*3}, {160+world_x, rob1y+rob1height*4} ])
	string : "Front bumper sensor"
	alignment : LEFT
	border : 1
};
window rob1backbumpsensor = {
	type : TEXT
	frame : ([ {60+world_x, rob1y+rob1height*4}, {160+world_x, rob1y+rob1height*5} ])
	string : "Rear bumper sensor"
	alignment : LEFT
	border : 1
};
window rob1lightsensor = {
	type : TEXT
	frame : ([ {60+world_x, rob1y+rob1height*5}, {160+world_x, rob1y+rob1height*6} ])
	string : "Light sensor"
	alignment : LEFT
	border : 1
};



window rob1motor1box = {
	type : TEXT
	frame : ([ {160+world_x, rob1y+rob1height}, {160+world_x+rob1height*2, rob1y+rob1height*2} ])
	string : if (robot1_motor1on==0) then "OFF" else "ON" endif
	alignment : LEFT
	border : 1
	sensitive : ON
};
window rob1motor2box = {
	type : TEXT
	frame : ([ {160+world_x, rob1y+rob1height*2}, {160+world_x+rob1height*2, rob1y+rob1height*3} ])
	string : if (robot1_motor2on==0) then "OFF" else "ON" endif
	alignment : LEFT
	border : 1
	sensitive : ON
};
window rob1frontbumpsensorbox = {
	type : TEXT
	frame : ([ {160+world_x, rob1y+rob1height*3}, {160+world_x+rob1height*2, rob1y+rob1height*4} ])
	string : if (robot1_frontbumperon==0) then "OFF" else "ON" endif
	alignment : LEFT
	border : 1
	sensitive : ON
};
window rob1backbumpsensorbox = {
	type : TEXT
	frame : ([ {160+world_x, rob1y+rob1height*4}, {160+world_x+rob1height*2, rob1y+rob1height*5} ])
	string : if (robot1_backbumperon==0) then "OFF" else "ON" endif
	alignment : LEFT
	border : 1
	sensitive : ON
};
window rob1lightsensorbox = {
	type : TEXT
	frame : ([ {160+world_x, rob1y+rob1height*5}, {160+world_x+rob1height*2, rob1y+rob1height*6} ])
	string : if (robot1_lightsensoron==0) then "OFF" else "ON" endif
	alignment : LEFT
	border : 1
	sensitive : ON
};



display rob1 = <rob1title /rob1motor1 / rob1motor2 / rob1frontbumpsensor / rob1backbumpsensor / rob1lightsensor /rob1motor1box / rob1motor2box / rob1frontbumpsensorbox / rob1backbumpsensorbox / rob1lightsensorbox>;

%eden

proc rob1motor1mouseclick : rob1motor1box_mouse_1 
{
  if (rob1motor1box_mouse_1[2] ==5) {
	if (robot1_motor1on==0) {robot1_motor1on=TRUE;} else {robot1_motor1on = FALSE;}
  }
}

proc rob1motor2mouseclick : rob1motor2box_mouse_1 
{
  if (rob1motor2box_mouse_1[2] ==5) {
	if (robot1_motor2on==0) {robot1_motor2on=TRUE;} else {robot1_motor2on = FALSE;}
  }
}
proc rob1frontbumpermouseclick : rob1frontbumpsensorbox_mouse_1 
{
  if (rob1frontbumpsensorbox_mouse_1[2] ==5) {
	if (robot1_frontbumperon==0) {robot1_frontbumperon=TRUE;} else {robot1_frontbumperon = FALSE;}
  }
}
proc rob1backbumpermouseclick : rob1backbumpsensorbox_mouse_1 
{
  if (rob1backbumpsensorbox_mouse_1[2] ==5) {
	if (robot1_backbumperon==0) {robot1_backbumperon=TRUE;} else {robot1_backbumperon = FALSE;}
  }
}
proc rob1lightsensormouseclick : rob1lightsensorbox_mouse_1 
{
  if (rob1lightsensorbox_mouse_1[2] ==5) {
	if (robot1_lightsensoron==0) {robot1_lightsensoron=TRUE;} else {robot1_lightsensoron = FALSE;}
  }
}
